3 BVTES 


{ 


!rO 


2 > 


3 BVTES 


{ 


!r0:2 } 


3 BVTES 


{ 


!rO 


2 > 



.DO External 
.LSTON 
.Page 
>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 

J. 

> Module: Math 
J. 

> BANK 1 hODULE 
> 

> This module contains a 1 1 the special purpose math routines 

> used in the Widget firmware. 
> 

> FUNCTION Diu3_19< fl : 3 BVTES < lrC:E > ) 

> FUNCTION Div3J38< fl : 3 BVTES { !rC:E } > 

> FUNCTION 0iv3_75<: fl : 3 BVTES { !rC:E > > 

> FUNCTION HulRO_m< RO : BVTE OK3 } > : 3 BVTES < !r0:2 } 

> FUNCTION DiMHdsSctrs< fl : 3 BVTES { !r0:2 } ) : 

> Quotient : BVTE { IrOrl > 

> Remainder : BVTE { }r3 } 

> FUNCTION DIvSctrsC fl : BYTE { !r3 > > : 

> Quotient : BVTE { !r2 > 

> Remainder : BVTE { Ir3 > 
> 

>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 

. LSTOFF 

.FIN 

-DO External 

.LSTON 

.Page 
>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 
> 

> Function: DiM3J<., DiM3_19, Diy3^38, DiM3_75 

> This function performs the following 24 bit arithmetic operations: 
> 

> DIm3_19 : Result <— R OIU 19 
> 

> Div3_76 : Result <— fi DJU 76 

> Inputs: 



> fl: 3 BS'TES { !rC, 

V 


IrO, 


!rE > 




> Outputs: 








> Result: 3 BVTES { 

> 

>:>>>>:»>>>>>>>>>>>>>>>>>>>>>>>>> 


IrO, 


in. 


Ir2 > 








.LSTOFF 








.FIN 








.DO Internal 








.LSTON 








.Page 








.FIN 








>>>>>>>>>>>:>>>>>>>>>> 









> Div3_19: Quotient := DiMidend DIM 19 
> 

> Local Uariables: 

> Divisor : 3 B^^TES { !rC:E > 

> Quotient : 3 BVTES { !r7:9 > 

> Dividend : 3 BVTES { Ir4:6 > 
> 

> BEGIN 

> Divisor := $013000 { 19 * 2'< 13 - 1 > > 



> Ooutlent := 

> FOR I := 1 TO 13 DO 

> IF < Dividend >= Divisor > 

> THEM 

> Dividend := Dividend - Divisor 

> Quotient := < Quotient * 2 > + 1 

> ELSE Quotient := < Quotient * 2 > 

> Divisor := Divisor DIU 2 

> END 
^> 

0iv3_76: Ld ScrRegC,»$04 ;D I visor := $04CO00 

Ld ScrRegD,«$CO 

Ld ScrRegE,«$00 

Jr Div3_x 

Div3_38: Ld ScrRegC,«$02 ;DI visor := $025000 

Ld ScrRegD,«$60 

Ld ScrRegE,«$00 

Jr Dlv3_x 



Diy3_19: Ld ScrRegC,«$01 jDi visor := $013000 

Ld ScrRegD,«$30 

Ld ScrRegE,«$00 

Div3_x: Ld ScrReg4, !rC jpciss dividend to routine 

Ld ScrRegS, !rD 

Ld ScrReg6JrE 

Push Rp ;save context 

Srp «l4rkJScr 

CIr !r? ;Quotient := 

CIr !r8 

CIr !r9 

Ld lrfi,«13 ; FOR i := 1 TO 13 DO 

Div3_1Q_Lp: Rcf ; clear carry 

RIc ?rQ .Quotient := Quotient * 2 

RIc !r8 

RIc Ir? 

Ld Ir0/lr4 ; IF ( Dividend >= Divisor ) 

Ld !r1,!r5 

Ld !r2, !r6 

Call Sub3 

Jr C.Div3_19_Div2 

Ld Ir4. IrO ; Dividend := Dividend - Divisor 

Ld !r5, \r^ 

Ld !r6, !r2 

Rdd !r9,*1 ; quotient := quotient + 1 

Rdc !r8,«0 

fide !r7,«0 

Div_3_19JDJv2: Rcf ; clear carry flag 

Rrc !rC ;Divisor := Divisor DIU 2 

Rrc IrD 

Rrc !rE 



D j nz ! rft , D I y 3_ 1 9_Lp 

Pop Rp ; con text switch 

Ld !r0j,ScrReg7 ;pass quotient to caller 

Ld I r 1 . ScrReg8 

Ld I r2, ScrRegQ 

Jp Bank-Ret 

.LSTOFF 

.DO External 

.LSTON 

-Page 
>>>>>>>>>>>>>>>>>>>>>>>>> 
> 

> Function: riulRO_m { Multiply RO by a > 
> 

> This function muliplies the byte in IrO by in where: 
> 

> For lOMbyte Profile: m = 256 

> For 20nByte Prof i te: m = 512 

> For SOMByte Profile: m = 1024 
> 

> Inputs: 

> fl : BVTE { IrO > 

> Outputs: 

> Result : 3 BVTES { !rC, IrO, !rE > 
> 

>>>>>>>>>>>>>>>>>>>>>>>>> 
.FIN 

.DO Internal 
.LSTOM 



numo_iB: 



FIN 



CIr IrE .Result := IrO * 256 
Ld IrO, !rO " 
CIr IrC 

.LSTOFF 

.DO M-20MB + I4_40MB 

.LSTON 

RIc IrE jResult := Result * 2 
RIc IrD 
Rlc !rC 

.LSTOFF 

.FIN 

.DO W_40NB 

.LSTON 

RIc IrE ;Result := Result * 2 

RIc IrD 

RIc IrC 

.LSTCFF 

.FIN 

.DO Internal 

.LSTON 

.FIN 



Jp Bank_Ret 



.LSTOFF 

.DO External 

.LSTOn 

. Page 
>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 
> 

> Function: DiyHdsSctrs { Divide by Heads * Sectors } 
> 

> This function takes the 24 bit word passed to it and returns 

> a 2 byte integer < representing the cylinder number > and 

> the remainder from the divide. 
> 

> Inputs: 

> fi : 3 BVTES { IrC, !rD, IrE } 
> 

> Outputs : 

> Cylinder : WORD { !!rO > 

> Remainder : 1 BVTE { !r3 > 
> 
>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 

.LSTOFF 

.FIN 

.DO Internal 

.LSTOh 

.FIN 

DlMHdsSctrs: 

.DO u_ioriB 

Ca I I i v:3_J38 ; re turn w i th ! rO : 2 = resu 1 1 

; ScrReg4:5 = remainder 
.FIN 

.DO M_20I1B + W_40f1B 

Call DiM3_76 ; re turn with Ir0:2 = result 

; ScrReq4:& = remainder- 
.FIN 

Ld IrOJrt ;HiCyl := .. 

Ld !r1,lr2 ;LoCyl := .. 

Ld fr:3^ScrReg& ; Remainder := . . 

Jp Bank_Ret 

.LSTOFF 

.00 External 

.LSTON 

.Page 
>>>:>>>>>>>>>>>>>>>>>>>>>>>>>>>> 
> 

> Function: DivSctrs { Divide by Sectors } 
> 

> This function takes the 1 byte word passed to it and returns 

> a ] byte integer < representing the head number ) and 

> the remainder from the divide ( the remainder is the sector * >. . 
> 

> Inputs: 

> fl : 1 BVTE { !r3 } 

> Outputs: 

> Quotient : 1 BVTE { !r2 > 

> Remainder : 1 BVTE { !r3 ) 
> 

> filgorithro: 
: > 



and 



Mote that there are only 2 ^leads on the widget, therefore 

if fi > NufflberOf Sec tors then Head := 1, eise Head ;= 

if fl > NumberOf Sec tors then Sector := fl - NumberOf Sec tors 

else Sector := fl 
fllso_, the sector is logically remapped to account for 
different inteaved drives. The mapping table Is located 
in the SpareTable: when the physical sector is found it's 
value is used as an index into the Map-Table and the value 
stored at that location of the table becomes the new sector. 



>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 
. LSTOFF 
.FIM 

-DO Internal 
.LSTON 
-Page 
.FIM 



DivSctrs: 



Ld 



!rO,»NbrSctrs ; load number of sectors Into !rO 





Cp 


\r3,\r0 


; check for fi g 




Jr 


Lt.DJSctrsI 






Ld 


!r2,«1 


; select head 1 




Sub 


!r3,lr0 






.Jr 


D_Sctrs2 




DJBctrsI: 


CIr 


Ir2 


; select head 


DjSctrs2: 


Ret 






ReMap_Sector: 


Push 


IrE ;save regs 






Push 


IrF 






Ld 


!rE,».HlBVTE. napjfable 




Ld 


lrF,«.LOUBVTE. 


l1ap_Tab 1 e 




Add 


IrF, IrO ; index 


into table 




fldc 


?rE,«0 






Lde 


lrO,@nrE ;get 


remapped sector 




Pop 


IrF 






Pop 


IrE 






Jp 


Bank_Ret 






.LSTOFF 







